CLAIMS 



We claim: 

1 . A method of tracking the orientation of a sensor, the method comprising: 

a) measuring an angular velocity of the sensor to generate angular rate 

values; 

b) integrating the angular rate values; 

c) normalizing the integrated angular rate values to produce an estimate 
of sensor orientation; 

d) measuring a magnetic field vector to generate local magnetic field 
vector values; 

e) measuring an acceleration vector to generate local gravity vector 
values; and 

f) correcting the estimate of sensor orientation using the local magnetic 
field vector and local gravity vector, 

2. A method of tracking as in Claim 1 wherein correcting the estimate of sensor 
orientation using the local magnetic field vector and local gravity vector comprises: 

g) determining a measurement vector from the local magnetic field vector 
values and the local gravity vector values; 

h) calculating a computed measurement vector from the estimate of 
sensor orientation; 

i) comparing the measurement vector with the computed measurement 
vector to generate an error vector that defines a criterion function; 

j) performing a mathematical operation that results in the minimization 
of the criterion function and outputs an error estimate; 
k) integrating the error estimate; 

1) normalizing the integrated error estimate to produce a new estimate of 
sensor orientation; and 

m) repeating steps a)-m), wherein the new estimate of sensor orientation is 
used for h), calculating a computed measurement vector until tracking is no longer 
desired. 
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3. The method of Claim 2 wherein the operation of j) 5 performing a mathematical 
operation that results in the minimization of the criterion function comprises 
minimizing the criterion function without calculating the criterion function. 

4. The method of Claim 2 wherein the operation of j), performing a mathematical 
operation that results in the minimization of the criterion function includes 
implementing a partial correction step to compensate for measurement error. 

5. The method of Claim 4 wherein implementing the partial correction step to 
compensate for measurement error is supplemented by using a weighted least squares 
regression to emphasize more reliable measurements with respect to less reliable 
measurements. 

6. The method of Claim 2 wherein the operation of j), performing a mathematical 
operation that results in the minimization of the criterion function comprises using 
time weighted filtering. 

7. The method of Claim 2 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function 
comprises using a Gauss-Newton iteration. 

8. A method of tracking the orientation of a sensor, the method comprising: 

a) measuring an angular velocity of the sensor to generate an angular rate 
quaternion; 

b) integrating the angular rate quaternion; 

c) normalizing the integrated angular rate quaternion to produce an 
estimated sensor orientation quaternion; and 

d) measuring a magnetic field vector to generate local magnetic field 
vector values; 

e) measuring an acceleration vector to generate local gravity vector 

values; 
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f) correcting the estimated sensor orientation quaternion using the local 
magnetic field vector and local gravity vector. 

9. A method of tracking as in Claim 8 wherein correcting the estimated sensor 
orientation quaternion using the local magnetic field vector and local gravity vector 
comprises: 

g) determining a measurement vector from the local magnetic field vector 
values and the local gravity vector values; 

h) calculating a computed measurement vector from the estimated sensor 
orientation quaternion; 

i) comparing the measurement vector with the computed measurement 
vector to generate an error vector that defines a criterion function; 

j) performing a mathematical operation that results in the minimization 
of the criterion function and outputs an error estimate quaternion; 
k) integrating the error estimate quaternion; 

1) normalizing the integrated error estimate quaternion to produce a new 
estimated sensor orientation quaternion; and 

m) repeating steps a)-m) 5 wherein the new estimated sensor orientation 
quaternion is used for h), calculating a computed measurement vector. 

1 0. The method of Claim 9 wherein the operation of j), performing a mathematical 
operation that results in the minimization of the criterion function comprises 
minimizing the criterion function without calculating the criterion function. 

1 1 . The method of Claim 9 wherein the operation of j), performing a mathematical 
operation that results in the minimization of the criterion function includes 
implementing a partial correction step to compensate for measurement error. 

12. The method of Claim 1 0 wherein implementing the partial correction step to 
compensate for measurement error is supplemented by using a weighted least squares 
regression to emphasize more reliable measurements with respect to less reliable 
measurements. 
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1 3 . The method of Claim 9 wherein the operation of j), performing a mathematical 
operation that results in the minimization of the criterion function comprises using 
time weighted filtering. 

14. The method of Claim 9 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function 
comprises using a Gauss-Newton iteration. 

15. A method of tracking the orientation of a sensor, the method comprising: 

a) providing a starting estimate of sensor orientation; 

b) measuring a magnetic field vector to generate local magnetic field 
vector values; 

c) measuring an acceleration vector to generate local gravity vector 

values; 

d) determining a measurement vector from the local magnetic field vector 
values and the local gravity vector values; 

e) calculating a computed measurement vector from the estimate of 
sensor orientation; 

f) comparing the measurement vector with the computed measurement 
vector to generate an error vector that defines a criterion function; 

g) performing a mathematical operation that results in the minimization 
of the criterion function and outputs an error estimate; 

h) integrating the error estimate; 

i) normalizing the integrated error estimate to produce a new estimate of 
sensor orientation; and 

j) repeating steps a)-j), wherein the new estimate of sensor orientation is 
used for e), calculating a computed measurement vector. 

1 6. The method of Claim 1 5 wherein each new estimate of sensor orientation is 
output as a sensor orientation signal. 
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17. The method of Claim 15 wherein the operation of g) ? performing a 
mathematical operation that results in the minimization of the criterion function 
comprises minimizing the criterion function without calculating the criterion function. 

1 8. The method of Claim 1 5 wherein the operation of g) 5 performing a 
mathematical operation that results in the minimization of the criterion function 
includes implementing a partial correction step to compensate for measurement error. 

1 9. The method of Claim 1 8 wherein implementing the partial correction step to 
compensate for measurement error is supplemented by using a weighted least squares 
regression to emphasize more reliable measurements with respect to less reliable 
measurements. 

20. The method of Claim 15 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function 
comprises using time weighted filtering. 

21 . The method of Claim 1 5 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function 
comprises using a Gauss-Newton iteration. 

22. The method of Claim 1 5 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs an error estimate includes: 

measuring an angular velocity of the sensor to generate angular rate values; 
integrating the angular rate values; 

normalizing the integrated angular rate values to produce an estimate of sensor 
orientation derived from the angular rate values; and 

using the estimate of sensor orientation derived from the angular rate values to 
correct for time lag. 



23. A method of tracking the orientation of a sensor, the method comprising: 

a) providing a starting estimate of sensor orientation quaternion; 
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b) measuring a magnetic field vector to generate local magnetic field 
vector values; 

c) measuring an acceleration vector to generate local gravity vector 

values; 

d) determining a measurement vector from the local magnetic field vector 
values and the local gravity vector values; 

e) calculating a computed measurement vector from the estimate of 
sensor orientation, using quaternion mathematics; 

f) comparing the measurement vector with the computed measurement 
vector to generate an 6x1 error vector that defines a criterion function; and 

g) performing a mathematical operation that results in the minimization 
of the criterion function and outputs a 4x1 quaternion error estimate; 

h) integrating the quaternion error estimate; and 

i) normalizing the integrated quaternion error estimate to produce a new 
estimated sensor orientation quaternion; 

j) repeating steps a)-j), wherein the new estimated sensor orientation 
quaternion is used for e), calculating a computed measurement vector. 

24. The method of Claim 23 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs a 4x1 quaternion error estimate comprises minimizing the criterion function 
without calculating the criterion function. 

25 . The method of Claim 23 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs a 4x1 quaternion error estimate comprises multiplying the 6x1 error vector by 
the function [X T X]" 1 X T . 

26. The method of Claim 23 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs a 4x1 quaternion error estimate further includes implementing a partial 
correction step to compensate for measurement error. 
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27. The method of Claim 23 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs a 4x1 quaternion error estimate comprises using a time weighted filtering 
system. 

28. The method of Claim 23 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs a 4x1 quaternion error estimate comprises using a Gauss-Newton iteration. 

29. The method of Claim 26 wherein implementing the partial correction step to 
compensate for measurement error is supplemented by using a weighted least squares 
regression to emphasize more reliable measurements with respect to less reliable 
measurements. 

30. The method of Claim 23 wherein the operation of g), performing a 
mathematical operation that results in the minimization of the criterion function and 
outputs a 4x1 quaternion error estimate includes: 

measuring an angular velocity of the sensor to generate an angular rate 
quaternion; 

integrating the angular rate quaternion; 

normalizing the integrated angular rate quaternion to produce an estimate of 
sensor orientation quaternion derived from the angular rate quaternion; and 

using the estimate of sensor orientation quaternion derived from the angular 
rate quaternion to correct for time lag. 

31. A sensor apparatus comprising: 

a magnetic field detector configured to measure a magnetic field vector and 
output a local magnetic field vector signal; and 

an acceleration detector configured to detect a local gravitational field vector 
and output a local gravitational field vector signal. 
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32. The sensor of Claim 3 1 , further includes an angular velocity detector 
configured to detect an angular velocity vector of the sensor and output angular 
velocity signal. 

33. The sensor of Claim 32 wherein, the angular rate detector comprises a three- 
axis angular velocity detector; the magnetic field detector comprises a three-axis 
magnetometer; and the acceleration detector comprises a three-axis accelerometer. 

34. The sensor of Claim 3 1 wherein the sensor includes at least one processor that 
receives and processes the signals from the magnetic field detector and the 
acceleration detector to determine the orientation of the sensor apparatus. 

35. The sensor of Claim 32 wherein the sensor includes at least one processor that 
receives and processes the signals from the magnetic field detector, the acceleration 
detector, and the signal from the angular velocity detector, wherein the at least one 
processor is configured to determine the orientation of the sensor. 

36. A system for tracking the posture and orientation of body, the system 
comprising: 

the body having mounted thereon at least one sensor; 

each sensor including a magnetometer for measuring a magnetic field vector 
and a acceleration detector for measuring a body acceleration vector, and 

at least one processor for receiving input from the magnetometer and 
acceleration detector and using said input to calculate a local magnetic field vector 
and a local gravity vector and to determine the orientation of the body. 

37. A system as in Claim 36 wherein the at least one processor is configured input 
the body orientation information into a synthetic environment; and 

wherein the system further includes a display for displaying the position and 
orientation of the body with respect to the synthetic environment. 



38. A system as in Claim 37 wherein the at least one processor is configured to 
correct for the offset between sensor coordinates and body coordinates, 
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39, A system as in Claim 36 wherein each sensor further includes an angular 
velocity detector for measuring a body angular velocity vector. 



5 40. A system as in Claim 39 wherein the at least one processing is configured 
input the body orientation information into a synthetic environment; and 

wherein the system further includes a display for displaying the position and 
orientation of the body with respect to the synthetic environment. 

10 41 . A system as in Claim 40 wherein the at least one processor is configured to 
correct for the offset between sensor coordinates and body coordinates. 

42. A system as in Claim 36 wherein the body comprises an articulated rigid body 
having a plurality of segments interconnected by at least one joint and wherein each 

15 segment has mounted thereon at least one sensor. 

43. A system as in Claim 39 wherein the body comprises an articulated rigid body 
having a plurality of segments interconnected by at least one joint and wherein each 
segment has mounted thereon at least one sensor. 

20 

44. A method of determining the direction of a local gravity vector with an 
acceleration detector, the method comprising: 

moving the acceleration detector from a start point to an end point over a time 

period; 

25 taking measurements of the total acceleration vector during the time period; 

weighted summing the measurements of the total acceleration vector over the 
time period; and 

calculating gravity vector values using the weighted sum of the total 
acceleration measurements. 

30 
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